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Robot Navigation 



Navigation 



Navigation is one of the most challenging competences required of 
a mobile robot. 









environment. 
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Robot Navigation 



Navigation 



Navigation is one of the most challenging competences required of 
a mobile robot. 



► Perception: The robot must interpret its sensors to extract 
meaningful data. 

► Localization: The robot must determine its position in the 
environment. 

► Cognition: The robot must decide how to act to achieve its 
goals. 

► Motion control: The robot must modulate its motor outputs to 
achieve the desired trajectory. 
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Robot Navigation (cont.) 
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Behavior-based Navigation versus Map-based Naviagtion 
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Do we need to localize or not? 



- To go from A to B, does the robot need to know 
where it is? 
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Do we need to localize or not? (cont.) 



How to navigate between A and B 

- navigation without hitting obstacles 

- detection of goal location 

Possible by following always the left wall 

- However, how to detect that the goal is reached 
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Do we need to localize or not? (cont.) 



Following the left wall is an example of "behavior 
based navigation" 

■ It can work in some environments but not in all 

■ With which accuracy do we reach the goal? 
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Do we need to localize or not? (cont.) 



1 In contrast to behavior based navigation, map based navigation relies on a map 
Assuming that the map is known, at every time slep the robot has to localize itself in the 
map. 

■ How? 

- If we know the start position, we can use wheel odometry or dead reckoning. 

■ Is this enough? 

■ What else can we use? 

But how do we represent the map for the robot? 

And how do we represent the position of the robot in the map? 
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Behavior-based Navigation 



sensors 



communicate data 



discover new area 



detect goal position 



avoid obstacles 



follow right /left wall 
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coordination / fusion 

e.g. fusion via veclor summation 
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Behavior-based Navigation (cont.) 



Advantages: 

► It may be implemented very quickly for a single environment with 
a small number of goal positions. 

Disadvatages: 

► The method does not directly scale to other environments or to 
larger environments. 

► The underlying procedures, such as left-wall-follow, must be 
carefully designed to produce the desired behavior. This task may 
be time-consuming and is heavily dependent on the specific robot 
hardware and environmental characteristics. 

► It may have multiple active behaviors at any one time. Even 
when individual behaviors are tuned to optimize performance, this 
fusion and rapid switching between multiple behaviors can negate 
that fine-tuning. 
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Map-based (or Model-based) Navigation 




sensors 




perception 



I 



localization / map-building 
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Map-based (or Model-based) Navigation (cont.) 

► Advantages: 

► The explicit, map-based concept of position makes the system's 
belief about position transparently available to the human 
operators. 

► The existence of the map itself represents a medium for 
communication between human and robot: the human can 
simply give the robot a new map if the robot goes to a new 
environment. 

► The map, if created by the robot, can be used by humans as well, 
achieving two uses. 
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Localization 

Beacon Based Localization Systems 
Odometry 

Map Based Localization 
nges of Localization 
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Localization 



Global localization 

■ The robot is not told its initial position 

■ Its position must be estimated from 
scratch 

Position Tracking 

■ A robot knows its initial position and 
"only" has to accommodate small 
errors in its odometry as it moves 
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How to localize? 

► Localization based on external sensors, beacons, or landmarks. 

► Odometry. 

► Map Based Localization: without external sensors or artificial 
landmarks, just use robot onboard sensors. Example: 
Probabilistic Map Based Localization. 
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Beacon Based Localization Systems: Triangulation 

► Ex 1: Poles with highly reflective surface and a laser for 
detecting them. 

► Ex 2: Coloured beacons and an omnidirectional camera for 
detecting them. 
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Beacon Based Localization Systems: KIVA Systems 



KIVA Systems, Boston (MA) 
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The Smart Ter Platform - Map and GPS Based 
Localization 




Three navigation SICK laser scanners 

Obstacle avoidance and local navigation 
Two rotating laser scanners (3D SICK) 

■ 3D mapping of the environment 
Scene interpretation 

Omnidirectional camera 

« Texture information for 
the 3D terrain maps 

■ Scene interpretation 
Monocular camera 

Scene interpretation 




Motion Estimation J Localization 

■ Differential GPS system 
(Omnistar 8300HR) 

■ Inertia! measurement unit 

(Crossbow NA V420) 

■ Optical Gyro 

■ Odometry 

(wheel speed, sleeping angel) 
Motion estimation 

■ Localization 
Internal car state sensors 

■ Vehicle state flags (engine, door, 
etc.) 

Engine data, gas pedal value 
Camera for life video streaming 

- Transmission range up to 2 km 
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Autonomous Navigation and 3D Mapping 
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Localization Cycle 



Improving belief state 

by moving (SEE and ACT) 
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Probabilistic Localization (example Kalman Filter) 



Continuous, recursive and very compact 
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Map Based Localization 




Map 

-data base 



** Position Updale 

""^ (Estimation?) 



Prediction of 

Position 
(e.g. odometry) 
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Odometry, Dead Reckoning 
Localization base on external sensors, 
beacons or landmarks 
Probabilistic Map Based Localization 
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Challenges of Localization 
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Challenges of Localization 

► Knowing the absolute position (e.g. GPS) is not sufficient. 

► Localization in human-scale in relation with environment. 

► Planning in the Cognition step requires more than only position 
as input. 

► Perception and motion plays an important role. 

► Exteroceptive sensor noise. 

► Effector noise. 

► Odometric position estimation. 
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Sensor Noise 



Source of Sensor Noise 



The source of sensor noise problems is that some environmental 
features are not captured by the robot's representation and are 
thus overlooked. 
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Sensor Noise 



Source of Sensor Noise 



The source of sensor noise problems is that some environmental 
features are not captured by the robot's representation and are 
thus overlooked. 

► For example, a vision system used for indoor navigation in an 
office building may use the color values detected by its color 
CCD camera. When the sun is hidden by clouds, the 
illumination of the building's interior changes because of the 
windows throughout the building. As a result, hue values are 
not constant. 
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Exteroceptive Sensor Noise 



► Sensor noise is mainly influenced by environment (e.g. surface, 
illumination ). 

► Sensor noise by the measurement principle itself (e.g. 
interference between ultrasonic sensors). 

► Sensor noise drastically reduces the useful information of 
sensor readings. 
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Exteroceptive Sensor Noise 



► Sensor noise is mainly influenced by environment (e.g. surface, 
illumination ). 

► Sensor noise by the measurement principle itself (e.g. 
interference between ultrasonic sensors). 

► Sensor noise drastically reduces the useful information of 
sensor readings. 



The solution is: 



1. To model sensor noise appropriately. 

2. To take multiple readings into account. 

3. Employ temporal and/or multi-sensor fusion. 
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Effector Noise: Odometry, Deduced Reckoning 




Odometry and dead reckoning: 

Position update is based on proprioceptive sensors 

■ Odometry: wheel sensors only 

■ Dead reckoning: also heading sensors 



The movement of the robot, sensed with wheel encoders and/or heading 
sensors is integrated to the position. 

■ Pros: Straight forward, easy 

■ Cons: Errors are integrated -> unbound 

Using additional heading sensors (e.g. gyroscope) might help to reduce 
the cumulated errors, but the main problems remain the same. 
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Odometry: The Differential Drive Robot 
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Odometry: The Differential Drive Robot (cont.) 



Kinematics 

A.v = AiCos(e + A8/2) 
Ay = As sin (9 + A9'2) 
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Odometry: The Differential Drive Robot (cont.) 



Error model 
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Odometry: Growth of Pose uncertainty for Straight Line 
Movement 

Note: Errors perpendicular to the direction of movement are 
growing much faster! 





Enoi Propagation in Oca met y 
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Odometry: Growth of Pose uncertainty for Movement on a 
Circle 



Note: Errors ellipse in does not remain perpendicular to the 
direction of movement! 



r Propagalon in Oaomtliy 



D -7 

r ° 6 
O 3 



:t=tzzzt:zz±T-±^fc::: 


:;:[■: 04=: 


- j j | { ^pQ 


v ■- 






i T i , i 


; - 



X3£*S>* 



CIS Faculty fflTJ 
Department of Information Systen 



Mansoura University 




Odometry: example of non-Gaussian error model 



Note: Errors are not shaped like ellipses! 



Courtesy Al Lab. Stanford 



• 




[Fox, Thrun, Burgard, Dellaert, 2000] 
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Odometry: Error sources 



deterministic 
(systematic) 



non-deterministic 
(non-systematic) 



■ deterministic errors can be eliminated by proper calibration of the system. 

■ non-deterministic errors have to be described by error models and will always lead to 
uncertain position estimate. 

Major Error Sources in Odometry: 

■ Limited resolution during integration (time increments, measurement resolution) 

■ Misalignment of the wheels (deterministic) 

■ Unequal wheel diameter (deterministic) 

■ Variation in the contact point of the wheel 

■ Unequal floor contact (slipping, not planar ...) 
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Odometry: Classification of Integration Errors 

1. Range error: integrated path length (distance) of the robots 
movement ==> sum of the wheel movements. 



2. Turn error: similar to range error, but for turns 
of the wheel motions. 



difference 



3. Drift error: difference in the error of the wheels leads to an 
error in the robots angular orientation. 



1 Over long periods of time, turn and drift errors far outweigh range 
errors! 

■ Consider moving forward on a straight line along the x axis. The error in the y- 
position introduced by a move of d meters will have a component of dsinAq, 
which can be quite large as the angular error Aq grows. 
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Odometry: Calibration of Errors I 



■ The unidirectional square path experiment 
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Odometry: Calibration of Errors II 



The bi-directional square path experiment 
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Belief Representation 
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Belief Representation 



Robot Position & Belief Representation 



How do we represent the robot position, where the robot 
"believes" to be? 






contain 
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Belief Representation 



Robot Position & Belief Representation 



How do we represent the robot position, where the robot 
"believes"to be? 

There are two specific concepts that the robot must represent: 

► The robot must have a representation (a model) of the 
environment, or a map. What aspects of the environment are 
contained in this map? 

► The robot must have a representation of its belief regarding its 
position on the map. 
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Belief Representation (cont.) 



1 a) Continuous map 
with single hypothesis 
probability distribution 

1 b) Continuous map 
with multiple hypothesis 
probability distribution 



1 c) Discreti^ed map 
with probability distribution 
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■ d) Discretizied topological 
map with probability 
distribution 
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Belief Representation: Characteristics 



'Continuous 



Discrete 



Precision bound by sensor data 

Typically single hypothesis pose 

estimate 

Lost when diverging (for single 

hypothesis) 

Compact representation and 

typically reasonable in processing 

power. 



Precision bound by resolution of 
discretisation 

Typically multiple hypothesis pose 
estimate 

Never lost (when diverges 
converges to another cell) 
Important memory and processing 
power needed, (not the case for 
topological maps) 
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Single-hypothesis Belief 

(a) real map with walls, doors and furniture; (b) line-based map 
around 100 lines with two parameters. 
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Single-hypothesis Belief (cont.) 

(c) occupancy grid-based map — ► around 3000 grid cells size 50 x 
50 cm; (d) topological map using line features and doors — > 
around 50 features and 18 nodes. 
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Multiple-hypothesis Belief 



► In the case of multiple-hypothesis beliefs regarding position, the 
robot tracks not just a single possible position but a possibly 
infinite set of positions. 

► The robot's position is described in terms of a convex polygon 
positioned in a 2D map of the environment. 

► It may be useful to incorporate some ordering on the possible 
robot positions, capturing the fact that some robot positions 
are likelier than others. 
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Grid-based Representation - Multi Hypothesis 
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Map Representation 
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Map Representation 

Three fundamental relationships must be understood when 
choosing a particular map representation: 

► The precision of the map must appropriately match the 
precision with which the robot needs to achieve its goals. 

► The precision of the map and the type of features represented 
must match the precision and data types returned by the 
robot's sensors. 

► The complexity of the map representation has direct impact 
on the computational complexity of reasoning about mapping, 
localization, and navigation. 
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Representation of the Environment 



Environment Representation 

■ Continuous Metric -* x,y,0 

■ Discrete Metric — >• metric grid 

■ Discrete Topological —>■ topological grid 

Environment Modeling 

■ Raw sensor data, e.g. laser range data, gray-scale images 

• large volume of data, low distinctiveness on the level of individual values 

• makes use of all acquired information 

■ Low level features, e.g. line other geometric features 

• medium volume of data, average distinctiveness 
■ filters out the useful information, still ambiguities 

■ High level features, e.g. doors, a car, the Eiffel tower 

• low volume of data, high distinctiveness 

• filters out the useful information, few/no ambiguities, not enough information 
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Map Representation: Continuous Line-Based 



a) Architecture map 

b) Representation with set of finite or infinite lines 
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Map Representation: Exact Cell Decomposition 



txact cell decomposition - Polygons 
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Map Representation: Approximate cell decomposition 



Fixed cell decomposition 
■ Narrow passages disappear 
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Map Representation: Approximate cell decomposition 
(cont.) 
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Map Representation: Occupancy Grid 



Fixed cell decomposition: occupancy grid example 

■ In occupancy grids, each cell may have a counter where indicates that the cell has not 
been hit by any ranging measurements and therefore it is likely free-space. As the number 
of ranging strikes increases, the cell value is incremented and, above a certain threshold, 
the cell is deemed to be an obstacle 

■ The values of the cells are discounted when a ranging strike travels through the cell. This 
allows us to represent "transient" (dynamic) obstacles 
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Map Representation: Decomposition 



1 Topological Decomposition 



node 

(location) 

edge 

(connectivity) 
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Example: Automatic Map building of topological map 
using vision 



■ Use SIFT features 
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Example: Automatic Map building of topological map 
using vision 





Topological Map 



; Coarse Grid Map 
ifor reference only) 
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Summary on Map representation 



Metric maps 

■ Continuous 

• For example line based, point based, or plane based 

■ Discrete 

• Exact cell decomposition 

• Approximate cell decomposition 

* Fixed cell decomposition (also occupancy grids) 

* Adaptive cell decomposition 
Topological 

Hybrid (mixture of metric and tolopological) 



,3, gz ; 



CIS Faculty 
Department of Information Systems 



Mansoura University 




State-of-the-Art: Current Challenges in Map 
Representation 



- Real world is dynamic 

- Perception is still a major challenge 

■ EError prone 

- Extraction of useful information difficult 

- Traversal of open space 

- How to build up topology (boundaries of nodes) 

- Sensor fusion 

- 2D. ..3D 



